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Inrichting voor het bepalen van de weg afgelegd door een 

♦ 

persoon te voet. 



De huidige uitvinding heeft betrekking op een inrichting 
voor het bepalen van de weg afgelegd door een persoon te 

* 

voet, meer speciaal voor het bepalen van de afgelegde 
af stand en/of van de gevolgde weg. 

Men kent reads zulke inrichtingen bekend onder de benaming 

'^Global Navigation System", bijvoorbeeld inrichtingen van 
■ * ■ . 

het type "^Gallileo", GPS en dergelijke. 

Men kent. ook reeds inrichtingen die gebaseerd zijn op de 
metingen van accelerometers die op het lichaam van de 
betreffende persoon zijn aangebracht . en die ' gekoppeld zijn 
aan een relatief cohiplexe randapparatuur met scanners, 
camera's en dergelijke. 

Een nadeel van zulke bekende inrichtingen is dat zij 
relatief complex en duur zijn en dat zij slechts een 
beperkte nauwkeurig- en betrouwbaarheid bezitten. 

• • ' 

Een ander nadeel is dat zij doorgaans een zeer omslachtige 
calibratieprocedure vereisen en dat zij relatief gevoelig 
zijn voor veranderli j ke magnetische velden, waardoor ze 
niet overal en niet voor alle toepassingen inzetbaar zijn. 



Nog een nadeel is dat' zulke inrichtingen ook een 
belangrijke rekencapaciteit vereisen, waardoor de 
resultaten veelal met vertraging beschikbaar zijn en zulke 
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inrichtingen dus niet geschikt zijn voor real time 
evaluaties. 

* 

Nog een ander nadeel is dat het met zulke inrichtingen niet 

steeds mogelijk is de richting te bepalen van • de 

verplaatsingen van de betreffen.de persoon te voet. 

Nog een ander nadeel is dat zulke inrichtingen vaak niet 
autonoom en draagbaar ingezet kunnen worden. 

De huidige uitvinding heeft tot doel aan 6§n of meer van de 
voornoemde en andere nadeien een oplossing te bieden. 

Hiertoe betreft de uitvinding een inrichting voor het 
bepalen van de weg afgelegd door een persoon te voet, die 
in hoofdzaak bestaat uit minstens drie inertiSle sensoren 
die op het lichaam van de persoon worden vastgehecht, 
respectievelijk een sensor op de romp, en een sensor op elk 
been, en die de absolute orientatie. met en van het 
betreffende lichaamsdeel waarop zij zijn bevestigd; 
middelen die toelaten het ogenblik te bepalen waarop de 
betreffende persoon een stap uitvoert; een rekeneenheid 
waarmee de sensoren en de voornoemde , middelen zijn 
verbonden, welke rekeneenheid een algoritme bevat dat 
toelaat, uitgaande van een aantal lichaaimsafmetingen van de 
persoon. in kwestie en van de ' signalen afkomstig van de 
voornoemde sensoren, voor iedere stap minstens de. 
stapafstand te bepalen alsook de gecumuleerde stapafstand 
vanaf een zeker vertrekpunt. 
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Uitgaande van een beperkt aantal lichaamsgegevens van de 
betreffende per soon te voet> zeals de lengte van de benen 
en de af stand tussen de heupgewrichten, is het mogeli j k om 
op relatief eenvoudige manier, op basis van de meetgegevens 
van de orientatie van de romp en van de benen, op ieder 
ogenblik de onderlinge positie te bepalen van de voeten van 
de persoon door toepassing van een meetkundig algoritme in 
de rekeneenheid. 

Aldus wordt het mogeli jk om voor elke stap, met andere 
woorden telkens wanneer de persoon zich met zijn beide 
voeten op de grond bevindt, de stapaf stand te bepalen en, 
door cumulatie van de opeenvolgende stapaf standen, de 
totaal afgelegde afstand vanaf een zeker Vertrekpunt te 
bepalen . 

Bij voorkeur is het meetkundig algoritme zodanig dat ook de 
staprichting bepaald kan worden, waardoor het ook mogeli jk 
wordt het traject te bepalen dat door de persoon werd 
afgelegd vanaf het voornoemde vertrekpunt. 

De inertiSle sensoren worden bij voorkeur op het lichaam 
van de persoon aangebracht door middel van een strak 
passend kledingstuk, bijvoorbeeld in de vorm van een broek 
of dergelijke, waarop de sensoren zijn vastgemaakt, op die 
wijze dat zij onbeweeglij k, of nagenoeg onbeweegli j k, zijn 
ten opzichte van de romp of van de benen. 

Zulke sensoren hebben het voordeel dat zij relatief klein 
zijn en de gebruiker bijgevolg nauwelijks hinderen in zijn 
bewegingen en bovendien dat de meetresultaten veel minder 
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gevoelig zijn aan schommelingen in het magnetisch veld, 
waardoor de bekomen resultaten veel nauwkeuriger en 
betrouwbaarder zijn dan de bekende systemen. 

De inrichting wordt bij voorkeur uitgerust met een 
draagbare elektrische voeding voor de sensoren en voor de 
rekeneenheid, waardoor de inrichting autonoom ingezet kan 
worden zonder bijkomende perifere toestellen. 

Met het inzicht de kenmerken van de uitvinding beter aan te 
tonen, zijn hierna, als voorbeeld zonder enig beperkend 
karakter, enkele voorkeurdragende uitvoeringsvormen 
beschreven van een inrichting volgens de uitvinding, met 
verwijzing naar de bijgaande tekeningen, waarin: 

figuur 1 schematisch een persoon te voet voorstelt die 
is uitgerust met een inrichting volgens de uitvinding; 
figuur 2 een blokdiagram weergeeft van een sensor die 
in figuur 1 is- aangeduid door pijl F2; 

figuur 3.de weg weergeeft die door de persoon te voet 
is afgelegd; 

figuur 4 een blokscheraa weergeeft van een Kalman 
filter, zoals toegepast in de inrichting van figuur 1; 
figuur 5 een variante weergeeft van figuur 1. 

in figuur 1 is een persoon 1 weergegeven die is uitgerust 
met een inrichting 2 volgens de uitvinding. 

De inrichting 1 bestaat in het weergegeven voorbeeld uit 
een kledingstuk 3 in de vorm van een broek of dergelijke 
die strak aansluit op het lichaam van de persoon 1 en 
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waarop vijf kleine lichtgewicht sensoren 4 zijn 
aangebracht, meer speciaal zogenaamde inertiele sensoren 
waarvan 6en sensor 4 op de romp is bevestigd, bijvoorbeeld 
door middel van een gordel 5, terwijl de andere sensoren 4 
zijn vastgemaakt ter plaatse van de benen, meer bepaald van 
de bovenbenen en van de onderbenen. 

De textielstof waaruit het kledingstuk 3 gemaakt is, heeft 
bij ' voorkeur als kenmerk goed wasbaar en goed 
zweetdoorlatend tezijn, een comfortabel gevoel te geven 
bij het dragen ervan, een goed contact te geven met het 
lichaam, zodat de sensoren 4 tijdens het bewegen van de 
persoon 1 niet verschuiven op het lichaam, en bovendxen, 
door de rekbaarheid van de stof, geen belemmering vormen 
voor de bewegingen van de persoon. 

Elk van de voornoemde sensoren 4 is gevormd door een. 
behuizing 6 waarin, zoals weergegeven in figuur 2, een 
aantal micro-sensorelementen zijn ondergebracht , namelx^k 
drie gyroscopen 7 die de absolute hoeksnelheid meten 
volgens drie onderlinge richtingen die bij voorkeur 
loodrecht op elkaar staan;' twee of in dit geval drie 
magnetometers 8 die het aardmagnetisme opmeten en samen een 
. elektronisch kompas vormen voor het meten van het azxmut 
van de sensor 4, meer bepaald van het azimut van een vast 
referentie-assenstelsel van de sensor 4; en ten slotte twee 
accelerometers 9 die de versnelling van de sensor 4 volgens 
de voornoemde drie loodrechte richtingen meet en dxe samen 
een elektronische waterpas vormen voor het " meten van de 
"' inclinatie en de rolpositie van de sensor 4, meer bepaald 
van de inclinatie en rolpositie van het voornoemde vaste 
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referentie-assenstelsel van de sensor 4. 

Andere mogelijke uitvoeringen van sensoren" 4 zijn niet 
uitgesloten. Zo kunnen bijvoorbeeld ook twee twee-assige 
magnetometers en twee twee-assige accelerometers worden 
gebruikt. Hetgeen van belang is, is dat de magnetometers en 
accelerometers metingen toelaten volgens drie richtingen 
die niet in hetzelfde vlak liggen, bijvoorbeeld volgens 
drie orthogonale richtingen, bijvoorbeeld een vertikale 
richting en twee loodrechte horizontals richtingen. 

De uitgangssignalen van de voornoemde n.icro-sensorelementen 
7-8-9 worden, eventueel na versterking door een yersterker 
10 en na omzetting in een analoge-digitale converter 11, 
verbonden . met een microprocessor 12 die in dit geval een 
databuffer vormt voor de meetgegevens van de betreffende 
sensor 4 en waarvan het uitgangssignaal, zoals . verder 
uitgelegd zal worden, een maat is voor de absolute 
ori^ntatie van het lichaamsdeel waarop de betreffende 
sensor 4 is bevestigd, met name de romp en de boven- en 
onderbenen. • De absolute ori^ntati^ . wordt bijvoorbeeld 
bepaald door het azimut, de inclinatie en de rolpositie van 
de sensor 4 . 



Het voornoemde uitgangssignaal wordt, al dan niet via een 
ste^'lcerverWading 13, doer een kabel 14 verbonden met een. 

re 



keneenheid 15 die .door de persoon 1 wordt gedragen 
bijvoorbeeld aan de gordel 5. 



De rekeneenheid 15 en de sensoren 4 worden gevoed door een 
batterij 16 of enig andere vorm van voeding, zoals 
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zonnecellen of dergelijke die bij voorkeur draagbaar is. 

De rekeneenheid is voorzien van een eerste algoritme dat 
toelaat om, uitgaande van, enerzijds, de signalen van de 
sensoren 4, en, anderzijds, de lichaamsafmetingen van de 
persoon in kwestie, meer speciaal de lengte van de boven - 
en onderbenen en de afstand tussen de heupgewrichten, op 
ieder ogenblik de positie te berekenen van de voeten van de 
persoon, en dit door middel van een meetkundige 
vectorberekening die in het bereik ligt van een iedere 
valanan en die hier dan ook niet verder in detail wordt 
behandeld. 

verder bevat de rekeneenheid een tweede algoritme dat 
toelaat, op basis van de signalen van de versnel.lingen van 
de accelerometers 9 van de sensoren 4, te bepalen wanneer 
de persoon 1 met zijn voeten contact maakt met de grond, 
waaruit het ogenblik kan worden afgeleid waarop de persoon 
een stap heeft gezet wanneer hij met zijn beide voeten de 
grond raakt. Ook dit tweede algoritme ligt in het berexk 
van de vakman- 

De werking van de inrichting 2 volgens de uitvinding is als 
volgt . 

wanneer de persoon 1 zioh te voet verplaatst. ontvangt de 
rekeneenheid opeenvolgend met een bepaalde freguentre de 
gegevens van de sensoren 4. 

op basis van deze gegevens wordt door middel van het tweede 
algoritme het ogenblik bepaald waarop de persoon 1, na het 
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neiuen van een stap, zijn voet op de grond zet . 

op dat ogenblik wordt door het tweede . algoritme de positie 
bepaald van de voeten van de persoon 1, waaruit de 
stapafstand L, evenals de staprichting van de persoon 1 
bepaald lean worden 

Zoals wordt afgebeeld in figuur 3, kan door opeenvolgende 
berekeningen van de stapafstand L en de staprichting van 
elke stap, op eenvoudige manier door cumulatie van de 
berekeningsresultaten, de totale stapafstand (L1+L2+L3+...) 
vanaf een bepaald vertrekpunt A evenals het gevolgde 
t raj act ABCDE, berekend worden. 

Dit laat toe aan de persoon in kwestie zijn positie op 
ieder ogenblik te kennen en de afstand die hij reeds heeft 
afgelegd- 

De resultaten van de ' berekening kunnen bijvoorbeeld worden 
gevisualiseerd op een scherm van de rekeneenheid. 

De rekeneenheid maakt gebruik van de afmetingen van de 
benen van de persoon 1 en van de afstand tussen > de 
heupgewrichten . 

Deze afmetingen kunnen worden gemeten op de betreffende 
persoon 1 en vervolgens via een klavier of dergelijke in de 



re 



keneenheid ingevoerd worden. 



Een andere mogelijkheid om deze gegevens in te brengen, i. 
door het calibreren van de inrichting. 
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Om de lengte van de bovenbenen en de af stand van de 
heupgewrichten te bepalen, zal bijvoorbeeld de betreffende 
persoon 1 met zijn knieen op de grond gaan zitten, met zijn 
knieen op een bepaalde afstand van. elkaar, waarna, na 
uitlezing van de signalen van de sensoren 4 voor deze 
positie, de gewenste afmetingen berekend kunnen worden door 
een omgekeerde berekening met het eerste algoritme. 

De lengte van de onderbenen kan vervolgens worden bepaald 
door bijvoorbeeld een stap uit te voeren met een gekende 
stapaf stand L en door vervolgens, uitgaande van de metmgen 
van de .serisoren 4, een omgekeerde berekening uit te voeren 
met het eerste algoritme. 

Zulke calibratie is dus zeer eenvoudig en vereist geen 
speciale bijkomende apparatuur zoals dit vaak het geval xs 
bij de bekende inrichtingen. 

zoals blijkt uit hetgeen voorafgaat, bekomt men van elke 
sensor 4 een signaal van de absolute ori^ntatie van de 
betreffende sensor 4, gekenmerkt door een azimut, een 
inclinatie en een rolpositie en dit op de volgende manxer. 

Gyroscopen 7 zijn over het algemeen zeer geschikt voor het 
raeten van orientatieveranderingen, ook tijdens (relatxef) 
snelle bewegingen. De uitgangssignalen van de gyroscopen 7 
zijn zoals bekend evenredig met de hoeksnelheid waarmee zx: 
zich bewegen. Door dit uitgangssignaal wiskundig te 
integreren in de tijd, bekomt men een absolute oriSntatxe 
hoekpositie van de betreffende gyroscoop 7 en dus ook van 
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de sensor 4 waarin deze geintegreerd is. 

Uit ■ de praktijk blijkt dat door integratie van het 
uitgangssignaal van een gyroscoop er steeds een toenemende 
afwijking ontstaat die genoegzaam bekend is als de 
zogenaamde drift van een gyroscoop 7. 

Oin de voornoemde drift • te • elimineren, wordt door de 
microprocessor 12 of door de rekeneenheid 15 de absolute 
orientatie die wordt bekomen uitgaande van de signalen van 
de gyroscopen 7 vergeleken met de absolute orientatie die 
bepaald wordf door de signalen van de voornoemde 
magnetometers 8 en van de accelerometers 9 en wordt 
uitgaande vah deze vergelijking de nodige correctie 
toegepast . 

Het corrigeren van de voornoemde drift van elke. sensor 4 
gebeurt sof twarematig door toepassing van een filter van 
het zogeheten Kalman-type. 

De werking van een dergelijke Kalman-f ilter wordt 
geillustreerd aan de hand van het blokschema van f iguur 4 . 

De signalen afkomstig van de gyroscopen, 7 worden door een 
bepaald, en op zichzelf bekend, sof twarealgoritme 17 
• geevalueerd, en omgerekend tot een best geschatte waarde 18 
van d^ absolute orientatie van de sensor 4, gekenmerkt door 
een azimut, een inclinatie en een rolpositie. Deze best 
geschatte waarde 18 wordt vervolgens vergeleken met de 
waarde 19 van de absolute orientatie van de sensor 4, 
gekenmerkt door het azimut, inclinatie en rolpositxe 
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gemeten door de magnetometers 8 en de accelerometers 7, 
hetgeen aanleiding geeft tot een correctiesignaal 20 voor 
het corrigeren van de drift- 

Dit correctiesignaal 20 wordt vervolgens af getrokken van 
het signaal 21 gemeten door de gyroscopen 1, een en ander 
zodanig dat na correctie een signaal 22 bekomen wordt dat, 
na integratie door een integratiesof tware 23, een correcte 
waarde 24 oplevert van de absoute oriSntatie van de 
betreffende sensor 4 die dan verder gebruikt wordt door het 
eerste algoritme voor de berekening van de voornoemde 
stapafstanden en staprichtingen . 

in figuur 5 wordt een variante weergegeven van een 
inrichting volgens de uitvinding zoals hiervoor beschreven, 
waarbij in dit geval de inrichting is uitgebreid met de 
volgende elementen : 

. een positioneersysteem 25 dat gekoppeld is aan -de 
voornoemde rekeneenheid 15, bijvoorbeeld in de vorm van 
een GPS-syteem; 

Lddelen 26 voor het tot stand brengen van een draadloze 
verbinding met een extern communicatienetwerk; 
. een aansluiting 27 voor de verbinding met een externe 
computer of PC 28. 

Door combinatie van de signalen van het positioneersysteem 
25 en van de berekeningsresultaten van de rekeneenheid 15 
bekomt men een zeer performant systeem voor het bepalen van 
de positie van ' de persoon 1, waarbij deze 
berekeningsresultaten als het ware een aanvulling vormen 



mi 
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voor de gegevens afkomstig van het positioneersysteem, 
waardoor de positie van de persoon 1 met een grotere 
nauwkeurigheid en betrouwbaarheid bepaald kan worden. 

Dankzij de draadloze verbinding kan de positie van de 
persoon 1 draadloos .via een communicatienetwerk worden 
getransfereerd naar een externa ontvanger, zodat de 
bewegingen van de persoon op af stand gevolgd kunnen worden. 

Door de aansluiting 27 kunnen de gegevens van de 
rekeneenheid 15 via een externe computer 28 worden 
uitgelezen. Voor een verdere evaluatie of verwerking van 
deze gegevens kunnen de algoritmes geladen en ge-updated 
worden en kunnen de gegevens van de gebruikers worden 
ingebracht . 

Alhoewel in het voornoemde voorbeeld de inrichting 2 is 
voorzien van vij f ' sensoren 4, is het niet uitgesloten dat 
slechts gebruik wordt gemaakt van drie sensoren 4, namelijk 
6en op de romp en een op elk been, meer speciaal e6n op elk 
bovenbeen of e6n op elk onderbeen. 

Het tweede algoritme dat toelaat het ogenblik te bepalen 
waarop de persoon 1 een stap uitvoert, kan ook worden 
■ vervangen door andere middelen die toelaten te bepalen 
wanneer de persoon na het nemen .van een stap zijn voet op 
de grond zet, bij voorbeeld. door druksensoren die zijn 
ingewerkt in de zolen van de persoon 1 en die in verbinding 
staan met de rekeneenheid 15. 

Het is duidelijk dat de voornoemde inrichting ook gebruikt 
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kan worden op dieren, op robots of dergelijke^ bijvoorbeeld 
teneinde de bewegingen ervan te kunnen volgen. 

De huidige uitvinding is geenszins beperkt tot de als 
voorbeeld beschreven eii in de figuren weergegeven 
uitvoeringsvormen, doch een inrichting volgens de 
uitvinding kan in allerlei vormen en afmetingen worden 
verwezenlijkt zonder buiten het kader van de uitvinding te 
treden. 
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Conclusies 



1.- Inrichting voor het bepalen van de weg afgelegd door 
een per soon te voet, daardoor gekenmerkt dat zij in 
hoofdzaak bestaat uit minstens drie inertiele sensoren (4) 
die op het lichaam van de persoon (1) worden vastgehecht, 
respectievelijk een. sensor (4) op de romp en een sensor (4) 
op elk been, en die de absolute orientatie meten van het 
betreffende lichaamsdeel waarop zij zijn bevestigd; 
middelen die toelaten het ogenblik te bepalen waarop de 
betreffende persoon (1) een stap uitvoert; een rekeneenheid 
(15) waarmee de sensoren (4) en de voornoemde middelen zijn 
verbonden, welke rekeneenheid (15) een .eerste algoritme 
bevat dat toelaat, uitgaande van een aantal 
lichaamsafmetingen van de persoon in kwestie en van 
signalen afkomstig van de voornoemde sensoren (4), voor 
iedere stap minstens de stapaf stand (L) , alsook de 
gecumuleerde stapafstand vanaf een zeker vertrekpunt te 
bepalen . 

2. - Inrichting volgens conclusie 1, daardoor gekenmerkt dat 
het voornoemd algoritme tevens toelaat de staprichting van 
elke stap te bepalen, evenals het traject dat door de 
persoon (1) werd afgelegd vanaf het voornoemd vertrekpunt. 

4 

3. - Inrichting volgens conclusie 1, daardoor gekenmerkt dat 

« 

de op de benen aangebrachte inertiele sensoren (4) zijn 
aangebracht op de bovenbenen. 
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4.- Inrichting volgens conclusie 1, daardoor gekenmerkt dat 
de op de benen aangebrachte inerti^le sensoren (4) zijn 
aangebracht op de onderbenen. 

5__. Inrichting volgens conclusie 1, daardoor gekenmerkt dat 
zij is voorzien van inertiele sensoren (4), zowel op de 
bovenbenen, als op de onderbenen. 

6. - Inrichting volgens conclusie 1, daardoor gekenmerkt dat 
zij een of meer kledingstukken (3) bevat die nauw 
aansluiten op de romp en op de benen van de betreffende 
persoon (1) en. waarop de voornoemde inertiele sensoren (4) 
vast zijn gemaakt. 

7. - Inrichting volgens conclusie 1, daardoor gekenmerkt dat 
zij is voorzien van een elektrische voeding (16) voor de 
sensoren (4) en voor de rekeneenheid (15), welke voeding 
(16) door de persoon meegedragen kan worden. 

8-- Inrichting volgens conclusie 1, daardoor gekenmerkt dat 
de inertiele sensoren (4) zijn opgebouwd uit twee of meer 
gyroscopen (7) die volgens onderlinge richtingen 
georienteerd zijn en uit een of meer magnetometers (8) en 
een of meer accelerometers (9) - 

9. - Inrichting volgens conclusie 8, daardoor gekenmerkt dat 
• in elk van de sensoren (4) een voornoemde microprocessor 

(12) is geintegreerd. 

10. - Inrichting volgens conclusie 9, daardoor gekenmerkt 
dat een softwaref liter is voorzien van het type Kalmah voor 
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het corrigeren van de drift van de voornoemde gyroscopen 
(7) door vergelijking van de signalen van de gyroscopen 
(7) , met de signalen van de magnetometers (8) en 
accelerometers (9) - 

11. - Inrichting volgens conclusie 1, daardoor gekenmerkt 
dat de middelen, die toelaten het ogenblik 'te bepalen . 
waarop de betreffende persoon (1) een stap uitvoert^ 
gevormd wordt door een tweede algoritme in de rekeneenheid 
(15) dat toelaat om, uitgaande van * de signalen van de 
accelerometers (9) van de inertiele sensoren (4) te bepalen 
wanneer de betreffende persoon (1) zich met zijn beide 
voeten op de grond bevindt . 

12. - Inrichting volgens conclusie 1, daardoor gekenmerkt 
dat zij een positioneersysteem (25) bevat dat gekoppeld is 
aan de voornoemde rekeneenheid (15) . 

13. - Inrichting volgens conclusie 1, daardoor gekenmerkt 
dat zij middelen (26) bevat voor het tot stand brengen van 
een draadloze verbinding met een communicatienetwerk. 

14. - Inrichting volgens conclusie 1, daardoor gekenmerkt 
dat zij voorzien is van een aansluiting (27) voor de 
verbinding met een computer. 
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Inrichting voor het bepalen van de weg afgelegd door een 
persoon te voet. 



Inrichting voor het bepalen van de weg afgelegd door een 
persoon te voet, daardoor gekenmerkt dat zij in hoofdzaak 
bestaat uit minstens drie inertiSle sensoren (4) die op het 
lichaam .van de persoon (1) worden vastgehecht, 
respeotievelijk een sensor (4) op de romp en een sensor (4) 
op elk been, en die de absolute orientatie meten van het 
betreffende lichaamsdeel waarop zij zijn bevestigd; 
middelen die toelaten het ogenblik te bepalen waarop de 
betreffende persoon (1) een stap uitvoert; een rekeneenheid 
(15) waarmee de sensoren (4) en de voornoemde middelen zijn 
verbonden, welke rekeneenheid (15) een eerste algoritme 
bevat dat toelaat, uitgaande van een aantal 
lichaamsafmetingen van de persoon in kwestie en van 
signalen afkomstig van de voornoemde sensoren (4), voor 
iedere stap minstens de stapaf stand (L) , alsook de 
gecumuleerde stapafstand vanaf een zeker vertrekpunt te 
bepalen . 



Figuur 1 . 



